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Uhhh... Inverse Kinematics? 
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Problem Description 

• We have a bunch of rigid bodies aka links 
(aka bones). 

• Pairs of links are connected by joints. 

• A joint limits the degrees of freedom 
(DoFs) of one link relative to the other. 

• Connection graph is a tree. No loops! 
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Problem Description (cont'd) 

• Let's consider 1-DoF joints only: 

• Revolute : single-axis rotation aka hinge. 

• Prismatic : single-axis translation aka slider. 

• Positions and velocities of links are 
defined by the values and speeds of the 
scalar joint parameters (angles, distances). 
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Problem Description (cont'd) 



Revolute 

Joint 
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Problem Description (cont'd) 

• Given some constraints on the poses and 
velocities of one or more links, compute a 
vector of joint parameters that satisfies the 
constraints. 

• The constrained links are called end- 
effectors, and are usually (but not per se) 
the end-links of a linkage. 



GAME DEVELOPERS CONFERENCE' 2014 


MARCH 17-21, 2014 GDCONF.COM 


Free vs. Fixed Joints 

• Usually, only a few joints are free. Free 
joints are available for constraint 
resolution. 

• The other joints are controlled by forward 
kinematics. Their positions and velocities 
are fixed at a given instance of time. 
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Position and Orientation 

• Each link maintains a pose, i.e. position 
and orientation, relative to its parent. 

• Position is a 3D vector. Orientation is a 
rotation matrix or a quaternion. 

• Position and orientation can be combined 
into a single entity as a dual quaternion. 
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Dual Quaternions 

• Quaternion algebra is extended by 
introducing a dual unit z, for which z 2 - 0. 

• Elements are 1, i,j, k, z, iz,jz, and kz. 

• A dual quaternion is expressed as: 

q = q + q's 

We call q the real part and q' the dual part. 
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Dual Quaternions (cont'd) 

• Multiplication gives: (q x + qi£)(q 2 + q^) 

= qiq 2 + (qiq 2 + qiq 2 )f + o 

• Real part is the product of real parts only; 
it does not depend on dual parts! 
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Dual Quaternions (cont'd) 


• Unit dual quaternions represent poses. 

• Given an orientation represented by a 
unit (real) quaternion q, and a position by a 
3D vector c, the pose is represented by: 




q + -cqe 


c is considered a pure 
imaginary quaternion 
(zero scalar part). 
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Dual Quaternions (cont'd) 

• The conjugate of a dual quaternion: 

q* = (q + q # <0*= q* + q' '*£ 

• The inverse of a unit dual quaternion is its 
conjugate: (q + q'f)(q + q'e)* = 

qq* + (qq'* + q'q*)^ = 1 + os 
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Dual Quaternions (almost done) 

• Given a pose q = q + q's, 

• The orientation is simply q (the real part). 

• The position is given by 2q'q*. 

• Exercise: Prove that for unit dual 
quaternions, 2q'q* has a zero scalar part. 


Hint: 


qq* + (qq'* + q'q*)e = 1 + Oe 
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Kinematic Chain 

• In a chain of links, r, is the relative pose 
from link / to its parent link / - 1. 

• The pose from a link / to the world frame 
is simply q t = r t ••• r if the product of all 
relative poses in the chain up to link /. 

• The pose from link / to link j is: q ; *q f 
(even if / and j are on different chains). 
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Relative Pose 

• The relative pose is the product of a fixed 
pose and a variable pose: f; = XjZj 

• x t fixes the joint axis relative to the 
parent's frame. 

• z i represents the joint's degree of 
freedom. 
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Relative Pose (cont'd) 



A A A 

• r* = XjZj 

• x; (transparent) 
fixes joint axis. 

• z i rotation 
about z-axis. 
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Relative Pose (cont'd) 

• W.I.o.g., we choose x* such that the joint 
axis is the z-axis of the new frame. 

• For a revolute: z t = cos(f) + sin(f)fc, 

rotating 6 radians about the local z-axis. 

d 

• For a prismatic: z t = 1 + -ks, 

translating d units along the local z-axis. 
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Positional Constraints 

• Find a vector of joint parameters that 
satisfies constraints on the poses of the 
end -effectors. Examples: 

• The feet of a character land firmly on an 
irregular terrain without interpenetration. 

• The gaze of an NPC follows some target. 

• The fingertip of a character presses a button. 
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Analytical Approach 


• Sometimes joint 
parameters can be 
solved analytically, 
e.g. the position of a 
piston is determined 
by the crank angle. 


Bore Centerline 
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Analytical Approach 

• However, polynomials of degree 5 and up 
can generally not be solved analytically. 

• Moreover, analytical solvers often yield 
multiple solutions which is less practical. 

• Can't get a closest-fit solution if a solution 
does not exists. 



GAME DEVELOPERS CONFERENCE' 2014 


MARCH 17-21, 2014 GDCONF.COM 


Iterative Approach 

• A constraint solution is approximated by 
taking many steps towards reducing the 
constraint error. 

• Converges to the nearest local minimum, 
which may not be a proper solution (should 
one exist). 
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Cyclic Coordinate Descent (CCD) 

• Iteratively solve each joint while keeping 
relative poses between other joints fixed. 

• "Solving" means minimizing some error. 

• Different strategies: Repeatedly 

• Work from end-effector to base. 

• Work from base to end -effector. 
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Cyclic Coordinate 


Minimize distance 
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Descent 

L 
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Cyclic Coordinate 


Minimize distance 
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Descent 

L 
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Cyclic Coordinate Descent 

• Minimize distance ♦ 
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Cyclic Coordinate Descent 

• Minimize distance ♦ 
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Cyclic Coordinate Descent 



Minimize distance 
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Cyclic Coordinate Descent 

• Pros: 

• Easy to implement 

• Linear time complexity (0(n) for n DoFs) 

• Cons: 

• May converge violently (requires relaxation). 

• Not fit for multiple simultaneous constraints. 
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Velocity-based IK 

• Satisfy positional constraints by solving 
joint speeds that move the end-effectors 
towards their desired poses. 

• Best solution for interactive animation: 

• Offers control over jerkiness. 

• Ideal for following a moving target. 
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Angular Velocity 


• The angular velocity of a rigid body is a 

3D vector. / / 

• Its direction points along the rotation axis 
following the right-hand rule. 

• Its magnitude is the rotatio 
radians per second. 
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Angular Velocity 

• Angular velocity is a 
proper vector: 

• The angular velocity 
of a link is the sum of 
all joint velocities 
along the chain. 
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X 
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Joint Velocity 

• The directions of the joint axes a, form a 
vector space for the angular velocity a> of 
an end-effector: 

• • 

<0 = a 1 0 1 + — I- a n 6 n 

• Here, 0, are the joint speeds in radians 
per second. 
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Joint Velocity 

• In matrix notation this looks like 



• The matrix columns are the n joint axes. 
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Joint Axis Direction 

• For q t = + q {e, link i's pose expressed in 

the world frame, the direction of the joint 
axis is the local z-axis in world coordinates: 
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Free & Fixed Joint Parameters 


• Move the fixed joint parameters over to 
the left-hand side 


<*>- (a^ + - + a M = a 


i+i 


• • • 






Here, only 9 i+1 to 6 n are variables. 
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Jacobian Matrix 

• The remaining matrix expresses the 
influence of changing joint speeds on the 
angular velocity of the end-effector (link n ). 

• This is in fact the Jacobian matrix. 

• #rows = #constrained DoFs. 

• #colums = #free joint parameters. 
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No Inverse 

• The Jacobian matrix generally does not 
have an inverse. 

• Often the matrix is not square, and thus 
not invertible. 

• Square Jacobians may not be invertible, 
since they can have dependent columns. 
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Too Few Variables 

• The constraints fix more DoFs than there 
are variables: 



• Likely, no solution exists. We settle for a 
best-fit solution. 
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Too Many Variables 

• The constraints fix fewer DoFs than there 
are variables: 



• Infinitely many solutions may exist. We 
seek the one with the lowest joint speeds. 
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Jacobian Transpose 


Quick-and-dirty solver: 


e 


i+i 


9 


= J T (w - (aA 


n 



• Good for getting the right trend, but no 
best-fit and no lowest joint speeds. 
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Jacobian Transpose (cont'd) 

• Needs a relaxation factor /? to home in on 
the sweet spot: 

( : ] = /?/ T (<*> _ (ai^i H t 

\ O n ) 

• Still, convergence is slow and 
unpredictable. 
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Pseudoinverse 


• The Moore-Penrose pseudoinverse J + 
defined as 





Giving: 
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Pseudoinverse (cont'd) 

• If no solution exists, returns a best-fit 
(least-squares) solution. 

• If infinitely many solutions exist, returns 
the least-norm (lowest speed) solution. 

• If an inverse exists, the pseudoinverse is 
the inverse. 
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Computing the Pseudoinverse 

• y + can be computed using open-source 
linear-algebra packages (Eigen, Armadillo+ 
LAPACK). 

• Cubic complexity! ( 0(n 3 ) for n variables) 

• Decimate into smaller Jacobians, rather 
than solve one huge Jacobian. 
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Orientation Alignment 

• End -effector's world frame q n is 
constrained to align with a target frame q t . 

• For moving targets, end -effector's angular 
velocity equals the target frame's: <o n = a> t . 

• Correct the alignment error by adding a 
correcting angular velocity to the target's. 
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Orientation Alignment (cont'd) 


• For aligning an end -effector's orientation 
to a moving target, solve: 


e 


i+i 



o 


n 


7 + (o) t - (a^i + ••• + a t di) - <o e ) 



GAME DEVELOPERS CONFERENCE' 2014 


MARCH 17-21, 2014 GDCONF.COM 


Orientation Alignment (cont'd) 

• As target velocity <o e , we choose the 
vector part of /?fq n q t *. 

• Here, quaternions q n and q t are the 
orientations of resp. end-effector and 
target, and h is the time interval. 

• Factor /?(< 1) relaxes correction speed. 
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There's a Twist... 

• Quaternions qand -q represent the same 
orientation. 

• For computing a) e , make sure that q n and 
q t point in the same direction (q n ■ q t > 0). 

• If not, then negate either q n or q t to take 
the shortest way home. 
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Linear Velocity 

• Linear velocity, unlike angular velocity, is 
bound to a point in space: 



I 
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Linear Velocity (cont'd) 

• Given angular velocity <o, and linear 
velocity v at point p, the linear velocity at 
an arbitrary point x is v + a> x (x - p). 



x 
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Plucker Coordinates 

• Angular and linear velocity of a link are 
combined into a single entity represented 
by a dual vector (aka Plucker coordinates): 

V = (a) + V° £ 

• Here, v° is the linear velocity at the origin 
of the coordinate frame. 
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Transforming Plucker Coordinates 

• Plucker coordinates are transformed from 
one coordinate frame to another using the 
dual quaternion "sandwich" product: 

qvq 

• Returns the image of velocity v after rigid 
transformation by unit dual quaternion q. 
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Deja Vu? 

• The (combined) velocity of a link is the 
sum of all joint velocities along the chain. 

• The joint axes a t form a vector space for 
the velocity v of an end-effector: 

v = a 1 d 1 + — l- a n 0 n 

• Here, O t are the revolute and prismatic 
joint speeds. 
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Deja Vu? (cont'd) 


• For q t = q t + qi's , link i's pose expressed in 
the world frame, the joint axis is the local 
z-axis in world coordinates: 


• For a revolute: 


/V 






* 


For a prismatic: 



0 

0 



* 
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Deja Vu? (cont'd) 

• End -effector's world frame q n is 
constrained to lock onto a target frame q t . 

• For moving targets, end -effector's 
velocity equals the target frame's: v n = v t . 

• To correct the error, we add the dual 
vector part of /^q n q t * to the target velocity. 
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Emotion FX Demo 
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Open-Source Code 

• Eigen: A C++ Linear Algebra Library. 

http://eiqen.tuxfamilv.org . License: MPL2 

• Armadillo: C++ Linear Algebra Library. 
http://arma.sourceforqe.net . License: MPL2 

• LAPACK - Linear Algebra PACKage. 

http://www.netlib.org/lapack . License: BSD 

• MoTo C++ template library (dual quaternion code) 
https://code.qooqle.eom/p/motion-toolkit/ . License: MIT 
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Thank You! 

My pursuits can be traced on: 

• Web: http://www.dtecta.com 

• Twitter: @dtecta 

• Or just mail me: qi no@dtecta.com 



